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(57) Abstract: The present invention discloses a position determination device (50) for 
an autonomous apparatus (1). The position determination device (50) comprises means 
(54) for dividing up driving of the autonomous apparatus (1), based on rotation veloc- 
ities of the driving wheels (17, 18), into different driving modes (40a-40u), in which 
the actual track width (30) of the apparatus (1) is substantially constant. The device 
(50) further comprises calibration means for calculating the actual track width (30) for 
each one of the driving modes (40a-40u). The calibration means performs a calculation 
method, in which the apparatus (1) is aligned in an initial direction and turns in one 
of the driving modes (40a-40u). The actual total turning angle of the apparatus (1) is 
measured together with the wheel rotations of the driving wheels (17, 18). Calculation 
of the actual track width (30) is performed on the basis of this actual total turning angle 
and the wheel rotations. 
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METHOD AND DEVICE FOR DETERMINING POSITION OF AN AUTONOMOUS 

APPARATUS 

TECHNICAL FIELD 

5 The present invention generally relates to autonomous apparatuses, and in particular to 
devices and methods for improving position determination thereof . 

BACKGROUND 

10 Autonomous apparatuses such as autonomous or robotic vacuum cleaners and other 
self moving devices are well known in the prior art, for example as disclosed in the 
International Patent Applications WO 97/41451 (US Patent No. 5,935,179) and WO 
00/38028, respectively. Such autonomous surface treatment apparatuses generally 
have a main body, being supported on or by a number of motor-driven wheels or 
15 rollers and means for surface treatment such as rotating brushes in combination with 
a vacuum cleaning device. Further, a sensing system, usually in combination with 
transmitters, is provided for guidance, navigation and obstacle detection. The sensing 
system generally sweeps around the horizon in analogy, for example, with a ship 
radar. A microprocessor together with appropriate software controls the transmitters 
and motors of the device. Normally, the microprocessor also receives input data 
from the wheels and the sensing system for the purpose of position information and 
localization of wall limitations as well as potential obstacles. This input data is then 
typically used as the basis for navigating the autonomous apparatus so that it, for 
instance, will be able to perform a cleaning function or other surface treatment 
function according to some predetermined strategy and at the same time avoid 
colliding with different obstacles, which may be arranged in the field of operation, 
besides avoiding collisions with limitations such as walls or the like. 

Typically, an autonomous apparatus orients itself at any time within its permitted 
motion area defined by a map on the basis of information obtained from the sensing 
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system. Furthermore, the map is typically generated and updated by the autonomous 
apparatus itself during its movements. It is often vital for the apparatus to obtain an 
as accurate map as possible, as well as an exact rationing and orientation within 
the area denned by the map, to be able to perform its operations. Several systems for 
5 position determination of autonomous apparatuses have therefore been developed, 
based on different techniques of prior art. Apparatus contained internal systems such 
as distance sensors in connection to wheels, have proven to be most cost effective. 

The internal position determination systems usually are composed of wheel sensms 
10 registering the rotational motion of the wheels. In order to determine how far the 
apparams has travelled since previous registration, the information from the wbed 
no*, is used together with the wheel diameter. This can be done with a 
reasonable good accuracy whea the surface is no. too soft, since the effective wheel 
then cun be assumed to be constant. When the surface is slippery or soft, 
,5 to apparatus may skid and/or the wheels may spin. The calculated tiavelfed dislance 
based on to wheel rotations is then incorrect compared to the actual diaance 
celled by the apparatus. In order to correct for mis slippage, a position calibration 
memodhastobeperformed. Such a method is disclosed in the US Patent 5,794,166. 
The method includes prediction of a cumulative overall slippage of the apparams 
20 occurring when me apparams .ravels from a sterling point to a destination pomt 
along an imaginary pad. This imaginary pad. includes a rotetion of to apparams a, 
to slatting point by a to. rotation angle so mat me apparams is directed towards the 
destination point. The apparams then travels forwards from the staring point to the 
tetill ation point PmaUy, a rotetion of me apparams at to destination point « 
25 p^fcrntedmaafignstoapparanBwimtore^ 

^.ermore, an overall slippage per wheel based or. a, leas, one distence depend*, 
prescribed slippage is calculated. To determine this, to distance between the 
effective contact pointe between to two driving wheels and to surface onto which 
» apparatus is to <*«ate, defined a. to -hack width" of to autonomous 
JO apparatus, must bo known. The track wktth is rbrtormomuffizedforcalculamrgto 
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rotational angle of the autonomous apparatus, as the apparatus moves along the 
imaginary path. 

A problem with the method disclosed in US Patent 5,794,166 is that the actual track 
width of the autonomous apparatus varies depending on the surface, as well as on the 
type and direction of the turn. The reason for this is both that the effective contact point 
varies and that the wheel suspension is not totally rigid . As the effective contact point is 
displaced during turning of the apparatus, the actual track width will change, and the 
slippage calculation method in US Patent 5,794,166 will foil and an erroneous rotation 
of the apparatus is performed. 

SUMMARY 

An object of die present invention is to provide an accurate position detennination 
method for autonomous apparatuses and devices therefore. Another further object of 
the present invention is to improve the position determination using a calibration 
method for calculating an actual track width of the apparatuses and devices therefore. 

The above objects are achieved by devices and methods according to the enclosed 
claims. In general words, an autonomous apparatus is equipped with a position 
detennination device for position determination and localization during its operation. 
The position device comprises encoders for generating signals corresponding to wheel 
rotations of the driving wheels. The position change and the heading of the apparatus 
since the previous recording are obtained from these wheel rotations, in combination 
with die diameter of the wheels and the track width of the apparatus . The motion of the 
autonomous apparatus is in the present invention divided up into different driving 
modes, each one associated with a separate actual track width. Each driving mode is 
preferably defined in such a way that the trade width of the apparatus is substantially 
constant with that driving mode. 
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the actual track width associated with each one or 

„ th p rotation means in turn comprises means for aligning the 

apparatus in an m*al di^on de.d ^ ^ whose ^ tra* 

5 source. The apparatus is then caused to turn means determines the total 

width is to be calculated. As the apparatus is turning, a means nete 
wid iod . ^^ fln external reference or some internal device. 

Encoders register the corresponding wheel J-,** ****** 

toe wheel rotation and a temporary track wtdih, an expected tornmg angr 
.tr^iffererK* between to actnal a* the expected tnming angles . the. 

track width based on the angle difference. 

f *. orcsent invention come as a result of the division of the 
Tte major advantages of the pntsent to****-** 

a* wiMh is snhaandally constant. Tms gores a > OT0Ile 
track width. 

BRIEF DESCRIPTION OF THE DRAWINGS 

. - th ^ objects and advantages thereof, will be best 
The invention, together with further objects ^ 
.n^erstoodby reference to the following description taken toge* 
accompanying drawings, in which: 

25 • t^j^t shnwine a vaaium-cleaning robot 

Fig. 1 mustrates a top view of an embodiment showing 

equipped according to the present invention; 

of the autonomous apparatus according to Fig. 1; 



Fig. 2 is a side view i 



30 
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Fig. 3 is a front view of the autonomous apparatus according to Fig. 1 ; 



Fig. 4 illustrates a hardware block diagram of the embodiment of Fig. 1; 

5 Fig. 5a, 5b and 5c illustrate different possible ways of defining driving modes of an 
autonomous apparatus according to the present invention; 

Fig. 6a and 6b illustrate the principles of associating the contact points between the 
wheels and the surface and an actual track width; 

Fig. 7 is a detailed view of the hardware block diagram of Fig. 4 illustrating the 
hardware and die software mainly used by the present invention; 

Fig. 8 illustrates a flow diagram of the position determination method of the present 
invention; and 

Fig. 9a and 9b are flow diagrams of the position calibration method of the present 
invention. 

DETAILED DESCRIPTION 

Throughout the drawings, the same reference characters will be used for corresponding 
or similar elements. 

In the following, the invention will be described with reference to a particular example 
of an autonomous apparatus, namely an autonomous vacuum-cleaning device. It 
should, however, be understood that the invention is not limited thereto, and that the 
invention is applicable to various other autonomous apparatuses, such as transport 
vehicles in manufacturing environments, movable multi-purpose robots and robotic 
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lawnmowers, as well as autonomous surface treatment devices for sweeping, 
brushing and floor polishing. 

In the present disclosure, "speed" refers to the absolute value of "velocity", which 
5 has both a magnitude and a direction, i.e. can be either positive or negative. 
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General features 

Rg iffli^inafti»fita»*»a<<*^ 

autonomous vacuum-cteaning device 1, which by itself will move on a floor and 
vacuum-cleat a room, to ft. fro* portion there is arranged an utaawmc system. The 
uttmsom. sysfcm comprises a strip-stop* ultras transmit 10 having a tength 
covering of the order 180" of ft. ftont pttrhreW of the ttevice as fltastraled in Rgs. 2 

ahpve a lower first row of microphone umts 12. Ahove ft. striped transmmer 
dement a second row of microphon. tutits 13 is localized. The utoasonie eeho sensor 
ata ^ tam 12 a* 13 tttgefter wift fte ttansmtter 10 ibm an utoasonie sonar 
syswn for the navigation of the device, to the flhstrattve embodime* the tmnsnutfcr 
tta^iaeer is counwsmted in a forward dhecled, movable bumper unit 16. The 
16 controls a left and a right bumper touch sensor, either one being actuate tf 
.ta^nntoc^wift^oh^toHgs^^Sftwmb.^ft-ft. 

device baa wo diametrically positioned wheels 17, 18. Each wheel 17, 18 > 

carter « around either wheel 17, 18. On ft. nk ftom each motor, driving fte 
resp ectiv. wheel 17 and 18, a respective quadra** sensor is tnounled. Quadmmre 
atertd, fam fte sensors are conrected to a built-in mtaoprccessor cot^Bing ». 
device The tugnals ftom ftesestmsom, or apfivata* devices winbeusedforobhdmng 
a ^ count for «timating the disance of travel. This is described more in d«ati 
below Optional whe.hr support ft. back of ft. device. The device is genially 
bdauced with a slightly larger weight on ft. rear half of the device, carrying for 
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instance the batteries, such that it will always move with all wheels in contact with the 
floor. Due to this balancing the device may easily climb the edges of floor carpets and 
the like. 

Further, the autonomous device may advantageously be equipped with Hall effect 
sensors, preferably one in front of each wheel, for detection of a magnetic fence and/or 
one or more magnetic strips in connection with the automatic charg ing station used for 
charging the device. The magnetic fence can be used to restrict the movement of the 
device. For example, the fence can be placed so that device does not fall down the 
stairs. It can also be placed so as to separate rooms without having to close the door. In 
this way, it is possible clean one room at a time, which has turned out to be an effective 
way of cleaning. 

Fig. 4 is a hardware block diagram of the device according to Figs. 1, 2 and 3. The 
hardware basically consists of a processor board, which is configured to drive the 
ultrasonic transmitter and the corresponding microphone based receiver system, the fan 
and brush motors, the two wheel motors, as well as other components of the 
autonomous vacuum-cleaning device. The processor board is essentially built around a 
data processor such as the MC68332 from Motorola Inc. 

The sonar localization sensing system formed by the transmitter and receiver system 
is utilized by the autonomous vacuum-cleaning device for obstacle detection 
purposes, such as detection of obstacles in the path of the moving device, pinpointing 
the exact location of the nearest obstacle. The processor controls the transmitter and 
receives input data from the receiver system for subsequent evaluation. 

The processor also controls the motor for the rotating brush as well as the motor for 
the fan, wherein the fan generates the necessary vacuum for the general function of 
the vacuum cleaner. Air from the fan motor is additionally in a known manner 
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a ♦»,. air i« exhausted at a Rilled outlet at the top of 
utilized for cooling purposes and the air is exhausted ai * g 

the device. 

The processor is controlled by software stored in a rannber of diflemnt types of digftal 
5 ■neowks for esample of type FPROM, RAM or EBFROM. which are aft weft known 

docking system CLK also known from (he prior art. 

The system as fflustrated in Kg. 4 further comprises a switches, two bumper 

,0 switches and two « swftches. The two bumper switches 

,0,^ . two TPU input pins working in discro* I/O nrode. and arousedasa 
foment to the sonar systenr for daecnon of colons with obstac^ The oft 

select one of a number of cleaning programs. 

Spa* represent o, d* magrcdc fieids tha, are sensed h, *e Hall sensors are . M 

20 roCproL>rv*d B A fl >c— ^ 

anronl^^^^^^^^ll^: 
HaU sensors may vary with ton, temperance and indMdna. s^, and d^orea 
«. fieM referee pott is consttnfly recatauafed wim a siow avemgmg fil.es and 
a ^based m pnlsewidmnKrfulated S ignabfiro m 

M m ordermde^n,dfi^,vari<»^ 

t_ -aw Hirprtlv via the A/I>converter or first through the 
the processor for evaluation, either directly via me 

multiplexer MUX and then via the A/Converter. 
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The wheel motors for driving the apparatus are separately controlled by pulse-width 
modulated signals of 5 kHz generated by two more channels from the Time 
Processor Unit in the main processor. In order to detect how much each wheel has 
rotated, the quadrature encoders mounted in connection with the wheels generate 
5 quadrature signals that are connected to Time Processor Unit (TPU) inputs of the 
MC68332. The quadrature signals are processed by the processor to provide position 
information by keeping track of the distance of travel and preferably also the rotation 
of the autonomous device during movement, which will be described in more detail 
below. 

10 

Position determination 

In Fig. 6a, a position determination of the autonomous apparatus 1 according to the 
present invention is performed using signals from encoders 51 , 52 located in 
connection to the driving wheels 17, 18. These encoders 51, 52 register the rotation 

15 of respective wheel 17, 18 and the signals are then outputted to a microprocessor. 
The microprocessor calculates the position change of the apparatus 1 since previous 
registration by combining the wheel rotation signals with information of the wheel 
diameters. In a first embodiment of the present invention the encoders 51, 52 are 
made of Hall sensors generating a quadrature signal in response to rotation of a 

20 magnetic disc 55 mounted in connection with the wheels 17, 18. The magnetic discs 
55 are discs divided up into a number of sectors with different magnetic directions. 
As the discs 55 rotate the encoders 51, 52 register the change in magnetism and can 
thereby measure the rotation of respective wheel 17, 18. Other embodiments are 
possible, such as slotted disc encoders and related devices. 



The signals from the encoders 51, 52 are not only used for determining travelled 
distances but also for calculating the heading of the apparatus 1 during its movement. 
Turning of the autonomous apparatus is given by: 
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AflJ "~ TrackWidth * 

^^^T^^^Z — is defied as the M 

throughout the entire procedure, l.e. there is no rrat 
wheels. 

40a-401 are defined by a respective range of ratios between 
VelLeftWheel 

, ^ v^ftWheel are the velocities of the two driving wheels 
17, 18, respectively, and A a*t»ar of<tefl nhig driving modes 

Sa.mcuotientwffl 
^^ce^lnare sy^eminto secrets, such a, 40amP* 5a 
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be the same if the magnitudes of the velocities of the two wheels are the same but the 
directions are different. If the ratio is the single defining parameter, driving forwards 
with both wheels and driving backwards with the same rotation speed of respective 
wheel are also defined, in this embwiiment, as the same driving mode. In Fig. 5a, 
5 sectors 40a and 40b are e.g. then associated with the same driving mode. However, 
additional defining parameters, such as the sign of one of the velocities, may also be 
used. The sectors 40a and 40b may then constitute separate driving modes. 

Fig. 5b illustrates another embodiment for defining driving modes 40m-40p of the 
10 present invention. The driving modes 40m-40p are defined in that the rotation 

velocity of one or both wheels is within a predetermined velocity range. The rotation 
velocities are, thus, limited by an upper rotation velocity limit and/or a lower 
rotation velocity limit. This can be applied for each wheel independently, 40m or 
40n, or simultaneously for both wheels 40o. m the latter case a more precise division 
15 of driving modes is obtained. For some operations it may, however, be sufficient to 
base die driving mode definition on the rotation velocity of only one wheel. The 
driving mode 40p illustrates the use of indefinite velocity range. 

The driving modes illustrated in Fig. 5b should only be interpreted as examples of 
possible driving modes. In a preferred embodiment, the driving modes should be 
complementary and together cover all allowed motion patterns. 

Fig. 5c illustrates yet another embodiment for defining the driving modes 40q-40u of 
the present invention, which today is considered as the most preferred embodiment. 
This definition divides the driving operation of the apparatus 1 into five driving 
modes, of which three 40r, 40t, 40u correspond to distinct velocity ratios and two 
40q, 40s correspond to ranges of rotation velocity ratios. 40r is the driving mode 
used for forward travel, where the rotation velocities of the two driving wheels 17, 
18 are the same. Here, any associated actual track width may be used, since die 
apparatus, at least ideally, does not turn. A compensation for unintentional turns 
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may, however, optionally be present. 40t and 40u illustrate driving modes taming 
the apparatus around its own axis on the spot in a respective direction. The 
magnitudes of the rotation velocities of the wheels are the same but the directions of 
rotation are opposite, in 40u the right wheel is rotating forwards whereas the left 
wheel is rotating backwards. The opposite is true for 40t, where the left rotates 
forwards and the right wheel rotates backwards. In order to torn while driving 
forwards, the two driving modes 40q and 40s are needed. 40q represents a mode 
involving turning the apparatus to the left and 40s represents a mode turning the 
apparatus to the right In the former driving mode, 40q, the right wheel is rotating 
forwards either alone or in combination with forward rotation of the left wheel. The 
rotation speed of the left wheel has, though, to be lower than the rotation speed of 
the right wheel . The same is true for 40s except that it is the left wheel that rotates 
alone or faster than the right wheel. In this definition of drivmg modes, me apparatus 
is never allowed to move backwards . It instead turns on the spot and then moves 
forwards. Its movement is, thus, limited to the five different drivmg modes, which 
are sufficient to cover the allowed motions used during operation of the autonomous 
apparatus 1 . A backward motion may, however, be used at special occasions, e.g. 
when the apparatus encounters an obstacle or a magnetic fence. If such motion is 
used, it is then preferably straight, whereby there is no track width dependence. 

The motion of the autonomous apparatus 1 is, as mentioned above, generally divided 
up into different driving modes 40a- 40u, in which the track width 30 may be 
considered as substantially constant. Figs . 6a and 6b- ffluminate the need for this 
division. 

Referring to Fig . 6a, this is a view of principle of the lower part of an autonomous 
apparatus 1 showing the effective contact points 31, 32 between the driving wheels 
17 i8andasurfece33,whenmeappamtusisdriving,fomards 
rotation speed on both driving wheels. The effective contact points 31, 32 of 
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of the lateral areas of the wheels 17, 18 that are in contact with the surface 33, as 
illustrated in Fig. 6a. These effective contact points 31, 32 define the actual track 
width 30 of the apparatus. 

In Fig. 6b, the actual track width 30 in a different driving mode is shown. In this 
driving mode the apparatus is turning right while driving. The effective contact point 
32 of the driving wheel in the direction of the turn, i.e. the right wheel 18, is 
displaced from the center of the lateral area as in Fig. 6a towards the side facing the 
turning direction. This displacement of contact points changes the actual track width 
30 of the apparatus, resulting in a noticeably different track width compared to the 
driving mode associated with Fig. 6a. 

Figs. 6a and 6b should merely be viewed as illustrative examples showing the 
dependence of the trade width 30 upon the driving mode of the apparatus 1 . The 
actual track width 30 and the effective contact points 31, 32 will change further at 
other driving modes but the spirit of the driving mode concept should be clear from 
the Figs 6a and 6b. 

Fig. 7 illustrates a part of the hardware block diagram of Fig. 4 in more detail, 
omitting the parts not directly used for position determination purposes. In order to 
move the autonomous apparatus 1, pulse-width modulated signals (PWM) are 
outputted from the Time Processor Unit in the microprocessor 21. These PWM 
signals control the applied voltage to respective driving motor and thereby control 
the rotation speed and direction of respective wheel. As mentioned above, encoders 
51, 52 register the wheel positions, generating quadrature signals that are forwarded 
to the microprocessor 21 , and corresponding velocities are determined. In order to 
determine the position change of the apparatus 1 since previous recording the actual 
track width 30 and the driving mode 40 of the apparatus 1 have to be determined. In 
the digital memories 20, software used for position determination, is stored. Based 
on the wheel positions, encoded in the quadrature signals, determination means 54 in 
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the digital memories 20 defcrntines the present driving mode 40 of me apparatus 1 
by use of wheei rotation velocities . From mis driving mode 40 me associated achtal 
traek width 30 is obtained, which is »*d in the snbserpent position calculations. 

use The driving mode and ttoefore also me definition of driving modes have to be 
Known. It might be, from operational point of view, most suitabiy to toM~* 
^definitions of driving modes, such as some of the definitions of ftp. 5a, 5b 
andSe The operatorcan then switchbeWecn definitions of difleren.se* of dnvmg 

perform a new operation where the former drivtag mode definition is not perfecfiy 

^53 star^inmedigi^memories^ wUehamlo^ande^mtae 

diLeter ofrespeetive wheel, whereas the heading is given by eqna^l^ 
20 s^taanhutiaiwefidefinedpositiona^ 

*.,««,nvPR and storing this information in the digital 
intervals as the apparatus moves, ana sronng m» 

m^a^y^^^^^" 1 

mparts t*****-***"**'-*-'*****"" 
untreated. 
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position catibration n^ o, tts present invention is preferably 
!L- — 22 afitms theautonomous apparatus 1 in annutialdtrechon. The 



30 aligning means 22 aligns 
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aligning means 22 controls the driving means 60 via the PWM signals from the 
microprocessor 21 so that the apparatus 1 turns and possibly also moves to face a 
direction selected by the aligning means 22. The aligning means 22 could preferably 
comprise magnetic detectors 23, 24, e.g. Hall sensors, detecting a magnetic field that 
5 is provided to direct the apparatus 1 in the correct direction. The magnetic field may 
originate from magnetic stripes or other magnetic sources, such as the magnetic 
fence and/or one or more of the magnetic strips in connection with the automatic 
charging station mentioned above. Other embodiments are also possible; the aligning 
means 22 may comprise push buttons that the operator pushes when the apparatus 1 
10 is to calculate the track width 30. The initial direction may then be the direction the 
apparatus is feeing when the button is pushed so no turning before the actual 
calibration is necessary. Alternatively, an external signal from some source may 
trigger the calibration method and the aligning means 22 then comprises a receiver, 
sensitive to the external signal. 

15 

Once the apparatus 1 has been aligned in the initial direction, the microprocessor 21 
sends PWM signals to the driving means 60. The driving means 60, in turn, causes 
the apparatus 1 to turn in the driving mode 40a-40u associated with the actual track 
width 30 to be determined. If the apparatus moves according to the driving mode 40r 

20 in Fig. 5c, it is actually moving straight ahead, i.e. not turning. In tins driving mode 
40r, the actual track width 30 is in feet arbitrary, e.g. given by the distance between 
the wheels and no calibration is necessary. On the other hand, for other possible 
driving modes an actual calculation is necessary to obtain the correct trade width. 
The actual total turning angle of the apparatus, during the turning in the selected 

25 driving mode, is then determined by reference means 80. The reference means 80 
uses some internal or external reference for obtaining the actual turning angle. 
Gyros, sensitive to changes in travelling direction, could be used as an internal 
reference for calculating the total turning angle of the apparatus 1. External 
references could be a magnetic field sensed by the magnetic detectors 23, 24 in the 

30 ali gning means 22 or other magnetic detectors. Just as for the initial aligning other 
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driving mode, the angle reMve the reference changes and the reference means 80 

5 preferabiy turnapredefermhrei^rurning angle, whichcg. cnnid he derernu«d 
5 preretaorymm p co-sponding to this torning, predetennmed or 

by (he operator. The wheel rotations corresponuius 

* Jsimuhaneonsiy regiaeredby the enters 51. 52. By nan* the wheel 

^.^canh.c.dcu^^nteansofaca.cnlanonn^ansTO. 

« ^ference means go, and me expect mrnh« angfe, obtah^ ftorn d« 

15 riLsTl Basedonthisdin^.acnrreettonof.te^ 

ejpeo^means 71. Based™ ^ fc ^ 

width is determined by eorreedon means 73. ine.en.i~ 

' ^«theacntaltrackwidra30ofu»apparatusl. 
calibrated to correspond to the acinar ua>- 



the apparatus. 

The track widths may, using iac ^ *;««*vfrtu* 
raemoriea 20 of me t-nomons apparahrs 1. As the ~"**T d 
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calculations are only performed if a new, until now not used, driving mode is 
encountered, and not every time the apparatus is started. Another possibility is to 
calculate the track width as the apparatus changes driving mode. In this way the 
calibration method has to be performed at least once for every new driving. The 
5 information may be stored in the memories 20 for later uses. However, preferably 
the calibration is performed regularly or when there are indications of changes in 
motion conditions. 

Fig. 8 illustrates a schematic flow diagram of the position determination method of 
10 the present invention. The method starts in step 100. In step 101, a wheel rotation is 
determined for the two driving wheels. A driving mode is then in step 102 
determined, based on the wheel rotations. In step 103, the position change since 
previous calculation is calculated, based on an actual track width, associated with the 
driving mode. Finally, the position determination method is completed in step 104. 

15 

The calibration method of the present invention is briefly described in Figs. 9a and 
9b. The calibration procedure starts in step 200. In step 201, the apparatus is aligned 
in the initial direction, decided by the operator or some external or internal input. 
The apparatus is then in step 202 caused to turn, in the driving mode associated with 
20 die actual track width to be calculated. The actual turning angle is determined in step 
203, using an external reference or an internal means. In step 204, the corresponding 
wheel rotations are registered preferably by encoders in connection with respective 
wheel. The actual trade width of the present driving mode is calculated in step 205, 
before the method is completed in step 209. 

25 

Fig. 9b describes a preferred manner to accomplish the calculation step 205 in more 
detail. In step 206, an expected total turning angle is calculated based on the wheel 
rotations and a temporary track width. The calculation continues in step 207, where 
a difference between the actual and the expected total turning angles is determined. 



5 
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mstep208,foeactualtrackwi^ ^ 
track width using the difference in step 207. Finally the mefcod is ended in step 209. 

It wwbe understood byaperson^ 

changes may be made to the present invention witot departure from the scope 
thereof, which is defined by the appended claims. 
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CLAIMS 

1. A position determination method for an autonomous apparatus (1), comprising 
the steps of: 

5 determining a wheel rotation of a first (17) and a second (18) wheel, 

respectively; and 

calculating a position change based on said first and second wheel rotations and 
a track width (30), characterized by the further step of: 

determining a driving mode (40a-40u) based on said wheel rotations, whereby 
10 said calculating step is based on an actual track width (30) associated with said 
driving mode (40a-40u). 

2. The method according to claim 1, characterized in that said driving mode 
(40a-40u) is defined by means of rotation velocities of said first (17) and said second 

15 (18) wheels. 

3. The method according to claim 2, characterized in that said driving mode 
(40a-401, 40q, 40s) is defined by a range of ratios between said rotation velocities. 

20 4. The method according to claim 2, characterized in that said driving mode 
(40m-40p) is defined in that said rotation velocity of said first wheel (17) is within a 
predetermined first velocity range. 

5. The method according to claims 2 or 4, characterized in that said driving 
25 mode (40m-40p) is defined in that said rotation velocity of said second wheel (18) is 

within a predetermined second velocity range. 

6. The method according to claim 2, characterized by five driving modes (40q- 
40u) defined by: 
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* a «rct (\Ti and forward rotation of said second 
forward rotation of said first wheel (it) ana iuiw 

wheel (18) with equal rotation velocities; 

foxward rotation of said first wheel (17) and backward rotation of said second 

wheel (18) with equal rotation speed; 
5 hlclrd rotation of said first wheel (17) a* forward rotation of sard second 

wheel (18) with equal rotation speed; . 

forward rotation o, said first whee, (17) ehher alone or in con— , w* 
forward movement of said second wheel (18), where the rotation s^edo, sari 
seeondwheeUl^islowernm^rotauons^ofsaidfiKtwheeUWand 

forward movement of .aid fir* wheel (17). where the rotation sp«d of sari first 
wheel (17) is lower than the rotation speed of said second wheel (18). 

7 . AealmmtirmmeflKXlforapo^^ 
15 (1), characterized by the steps of: 

aBgning said antonomons apparams (1) in an initial dtocfon; 

"aaid aotonomoos apparams (!) in a first of , — « of drivn* modes 

20 measuring a wheel motion o, a fir* (.7) and a second (18) wheC 

""SC - aema, writi, (30) associafcd writ said «-«•-- 
(40 al) on sari measured wheel rotations and said detennined achtal total 

turning angle. 

25 -a- . rt ,i n im7 «2haracterized in that said calculating step in 

8. The method according to claim 7 , cnaracierMcu 

tam comprises the steps of: 0 „„ ara t,,c m 

casting an expect Wal hurting angle of said aumnomous apparams (1) 

tesed on said mealed wheel mtations and a temporary track writi* 



WO 02/075469 PCT/SE02/00420 

21 

calculating a difference between said expected and said actual turning angles of 
said autonomous apparatus (1); and 

determining said actual track width (30) as a correction of said temporary track 
width based on said difference. 

5 

9. The method according to claims 7 or 8, characterized in that said driving 
modes (40a-40u) are defined by means of rotation velocities of said first (17) and 
said second (18) wheels. 

10 10. The method according to claim 9, characterized in that said driving modes 
(40a-401, 40q, 40s) are defined by a range of ratios between said rotation velocities . 

11. The method according to claim 9, characterized in that at least one of said 
driving modes (40m-40p) is defined in that said rotation velocity of said first wheel 

15 (17) is within a predeterrDined first velocity range. 

12. The method according to claims 9 or 11; characterized in that at least one of 
said driving modes (40m-40p) is defined in that said rotation velocity of said second 
wheel (18) is within a predetermined second velocity range. 

20 

13. The method according to claim 9, characterized by five driving modes (40q- 
40u) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 
25 forward rotation of said first wheel (17) and backward rotation of said second 

wheel (18) with equal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 
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u 1 nr. either alone or in combination with 
fotw ard rotadon of said « * • ^ ^ of ^ 

t^rf movement of said second wheel W. 

forward movement of said first wheel (">• vtae 

rtflWng an operator input or an external mpot. 

in that said external input is 

a!ig))a l ee*rated by deletion of .magnetic field. 

Ar-*— — •'r.'* 9 .^ ^don of a tot (17) and a second 
^ ( 5i, 52) to determnnng a wheel rotat. 

«> wheeU calcolating a position change based • said tot and 

«—— — «> *• **" ^ ^ calculation means ben* 

— — ^^ 5 ;rm^i«^^- ctaraete ^ 

SO connected to said means (51, 52) for measunug 

» , .^wna a drrving mode (4to-40n) based on said wheel 

means (54) for deternmnng drrvmg ^ 

25 said driving mode (40). 

16 characterteed in that said driving mode 
17 . device according to clann 16 ' ^ (17) ^ said seco^l 

(40a -40u) is defined by means of rotation velocities 



15 16. 



(18) wheels. 



30 



WO 02/075469 PCT/SE02/00420 

23 

18. The device according to claim 17, characterized in that said driving mode 
(40a-401, 40q, 40s) is defined by a range of ratios between said rotation velocities. 

19. The device according to claim 17, characterized in that said driving mode 
5 (40m40p) is defined in that said rotation velocity of said first wheel (17) is within a 

predetermined first velocity range. 

20. The device according to claims 17 or 19, characterized in that said driving 
mode (40m-40p) is defined in that said rotation velocity of said second wheel (18) is 

10 within a predetermined second velocity range. 

21. The device according to claim 17, characterized by five driving modes (40q- 
40u) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
15 wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 
20 forward rotation of said first wheel (17) either alone or in combination with 

forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than die rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or in combination with 
forward movement of said first wheel (17), where the rotation speed of said first 
25 wheel (17) is lower than the rotation speed of said second wheel (18). 

22. The device according to any of die claims 16 to 21, characterized by position 
calibration means in turn comprising: 

means (22) for aligning said autonomous apparatus (1) in an initial direction; 
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means (21) for causing driving means (60) to torn said autonomous apparatus 
(1) in a first of a number of driving modes (40a-40u); 

* ' means (80) for determining an actual total turning angle of said autonomous 



first calculation means (70) for calculating said actual track width (30) 
associated with said first driving mode (40a-40u) based on said measured wheel 
rotations and said determined actual total turning angle. 

23. The means according to claim 22, characterized in that said first calculation 

10 means (70) in torn comprises: 

second calculation means (71) for calculating an expected total turning angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 

temporary track width; 

third calculation means (72) for calculating a difference between said expected 

15 and said actual turning angles of said autonomous apparatus (1); and 

means (73) for determining said actual track width (30) as a correction of said 
temporary track width based on said difference. 

24 A position calibration means of an autonomous apparatus, characterized by 
20 means (22) for aligning said autonomous apparatus (1) in an initial direction; 

means (2 1) for causing driving means (60) to torn said autonomous apparatus 
(1) in a first of a number of driving modes (40a-40u); 

means (80) for determining an actual turning angle of said autonomous 

apparatus (1); 

25 means (51. 52) for teaming a wheel rotation of a tat wheel (17) and a 

second wheel (18), respectively; and 

M calculation tneans <70) foi calculating an acted track width (30) assorted 
with said ftat driving mode (40a-40u) based on said measured wheel rotations and 
said determined actual total turning angle, said first calculation means (70) bemg 
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connected to said means (80) for determining said actual turning angle and said 
means (51, 52) for measuring said wheel rotations. 

25. The means according to claim 24, characterized in that said first calculation 
means (70) in turn comprises: 

second calculation means (71) for calculating an expected total turning angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 
temporary track width; 

third calculation means (72) for calculating a difference between said expected 
and said actual turning angles of said autonomous apparatus (1); and 

means (73) for determining said actual track width (30) as a correction of said 
temporary track width based on said difference. 

26. The means according to claims 24 or 25, characterized in that driving modes 
(40a-40u) are defined by means of rotation velocities of said first (17) and said 
second (18) wheels. 

27. The means according to claim 26, characterized in that said driving modes 
(40a-401, 40q, 40s) are defined by a range of ratios between said rotation velocities. 

28. The means according to claim 26, characterized in that at least one of said of 
driving modes (4Qm-40p) is defined in that said rotation velocity of said first wheel 
(17) is within a predetermined first velocity range. 

29. The means according to claims 26 or 28, characterized in that at least one of 
said of driving modes (4Gm-40p) is defined in that said rotation velocity of said 
second wheel (18) is within a predetermined second velocity range. 

30. The means according to claim 26, characterized by five driving modes (40q- 
40u) defined by: 
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fOTWard rotMi on of said m V0 - *— — * * ^ 

-srisrs^-— ------ 

* i<W **'T i r* (17) eid*r alone or in cordon «*» 
forwa rd rotation of sard ^ ^ of said 

^ of said second atoel ^^^^^^ 

^a^l^^^ro^speedof^secoodwtaeU.S). 

31. xberr^ according to any of tt* .^ auW1(m „apparat»s 

itin? to claim 31 f characterized in that said external input 

32. The means according to claim si, 
means is a magnetic field detector. 

20 ♦ ci ft hn 32 characterized in that said magnetic field 

33. The means according to claim 32, cnaract 

detector is a Hall sensor (23, 24). 
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